### 2021/3/17 v1
### author zkm
### github zkm98
### brief used for the reading of the robot path in different time
from util import *
robot_pose_after_tracking,robot_pose_before_executing,robot_pose_after_planning = [],[],[]
#%%

robot_pose_after_tracking = read_pose_file("robot_pose_after_tracking_"+times+".txt")
robot_pose_before_executing = read_pose_file("robot_pose_" + times + ".txt")
robot_pose_after_planning = read_pose_file("hg_robot_pos_after_planning_"+ times + ".txt")